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A position-coupling element (2) continuously determines the actual position of the vehicle in a plane, 
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Bet dem. Verfahren wird die Ist-Lage des Fahrzeuges 
wahrend der Fahrt durch kuppelnde Verfahren erfaSt. Die 
odometrische Navigation fiihrt bei der Uberwindung groSe- 
rer Entfernungen zu Abweichungen zwischen 1st- und Soil- 
Position. 

Um wesentliche Abweichungen der Ist-Position von der 
Soli-Position beim Zurucklegen groSerer Entfernungen des 
Fahrzeuges zu verhindern, wird eine Stutzmessung durchge- 
fuhrt, bei der die Abweichung der durch kuppelnde Verfah- 
ren bestimmten. Ist-Lage des Fahrzeuges an hand raumfe- 
ster, in der Lage bekannter Stiitzpunkte ermittelt wird. 
Aufgrund dieser Abweichungen wird die Ist-Lage korrigiert 
und der korrigierte Wert zur weiteren Verarbeitung zur 
Verfugung gestelft. Infolge der Integration in bestehende 
Systeme ist die Losldsung von Leitspuren moglich. Dabei 
Gberhinimt das Lageerfassungsmodul die Aufgabe der bis- 
herigen Leitspuren. 

Das Verfahren f und das Lageerfassungssystem ermoglichen, 
auch groBe v ».Distanzen zwischen dem Ausgangs- und dem 
Zielort des Fahrzeuges ohne Leitspuren und bei Einhaltung 
vorgegebener Toleranzen zu uberwinden. 
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Beschreibung 

Die Erfindung betrifft ein Verfahren zur Ist-Lage-Er- 
fassung von landgebundenen Fahrzeugen, insbesondere 
von mobilen autonomen Rechnern, von Gabelstaplern 
und dgl., nach dem Oberbegriff des Anspruches 1 sowie 
ein Lageerfassungssystem zur Durchfiihrung eines sol- 
chen Verfahrens nach dem Oberbegriff des Anspruches 
10. 

Die derzeitigen Verfahren zur Ist-Lage-Erfassung 
von Fahrzeugen basieren zumeist auf dem Verfolgen 
einer Leitspur, wobei induktive, optische Verfahren und 
dgl. angewendet werden. Es ist auch bekannt, die Fahr- 
zeugposition durch digitale oder analoge Geber rein 
odometrisch zu erfassen. Die rein odometrische Naviga- 
tion fuhrt bei der Oberwindung grdBerer Entfernungen 
sehr schnell zu nicht mehr tolerierbaren Abweichungen 
zwischen Ist- und Soil-Position. 

Der Erfindung liegt die Aufgabe zugrunde, das gat- 
tungsgemaBe Verfahren und das gattungsgemaBe Lage- 
erfassungssystem so auszubilden, daB das Fahrzeug 
auch groflere Entfernungen zuriicklegen kann, ohne daB 
eine wesentliche Abweichung der Ist- Position von der 
Soil- Position auftritt. 

Diese Aufgabe wird beim gattungsgemaBen Verfah- 
ren erfindungsgemaB mit den kennzeichnenden Merk- 
malen des Anspruches I und beim gattungsgemaBen 
Lageerfassungssystem erfindungsgemaB mit den kenn- 
zeichnenden Merkmalen des Anspruches 10 geldst. 

Die Lagekoppelung und die Verwendung des Lage- 
stUtzungselementes erlaubt die Oberwindung groBer 
Entfernungen durch das Fahrzeug. Infolge der Integra- 
tion in bestehende Systeme ist die Loslosung von Leit- 
spuren moglich. Dabei iibernimmt das Lageerfassungs- 
modul die Aufgaben der bisherigen Leitspur. Es ist da- 
mit moglich, auch groBe Distanzen zwischen dem Aus- 
gangs- und dem Zielort des Fahrzeuges ohne Leitspur 
zu uberwinden, ohne die vorgegebenen Toleranzen der 
Positionsgenauigkeit zu uberschreiten. Wahrend der 
Fahrt wird laufend die Ist- Position gekoppelt. Je nach 
Lange des zuriickzulegenden Weges werden ein oder 
mehrere Stiitzmessungen durchgefuhrt. Hierbei wird 
anhand raumfester, in ihrer Lage bekannter Stutzpunk- 
te die tatsachliche Lage des Fahrzeuges mit dem Lage- 
erfassunsgmodul ermittelt. Die Stutzmessung wird so- 
mit der laufenden gekoppelten Messung uberlagert, so 
daB Fehler bei der gekoppelten Lageerfassung durch 
die Stutzmessung ausgeglichen werden konnen. Die 
Stutzmessung wird vorteilhaft in solchen Zeitabstanden 
vorgenommen, daB nicht zu groBe ICorrekturen durch- 
gefuhrt werden miissen. Dadurch laBt sich eine sehr 
hohe Positionsgenauigkeit des Fahrzeuges erzielen, 
auch wenn von ihm groBe Strecken zuruckgelegt wer- 
den mussen. Da das Lagekoppelungs- und das Lagestut- 
zungselement in einem gemeinsamen Modul zusam- 
mengefaflt sind, steht ein kompakter Sensor zur Verfii- 
gung, der in unterschiedlichste Anwendungen einge- 
bracht werden kann. Ober eine Schnittstelle stehen der 
nachfolgenden Anwendung die innerhaib des Moduls 
schon vollstandig aufbereiteten Lageinformationen zur 
Verfugung. Darum entfallen komplexe Verknijpfungen 
und algorithmische Verarbeitungen der bisher zur 1-a- 
gestOtzung und Lagekoppelung eingesetzten Sensor- 
komponenten. Der Engineeringaufwand beim Einsatz 
des erfindungsgemaBen Moduls verringert sich stark 
gegeniiber dem konventionellen Einsatz einzelner sepa- 
rater Sensorkomponenten. 

Weitere Merkmale der Erfindung ergeben sich aus 
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den weiteren Anspruchen, der Beschreibung und den 
Zeichnungen. 

Die Erfindung wird anhand einiger in den Zeichnun- 
gen dargestellter Ausfiihrungsbeispiele naher erlautert. 
5 Es zeigen 

Fig. 1 in einem Blockdiagramm ein erfindungsgema- 
Bes Lageerfassungsmodul, mit dem die Position und die 
Orientierung eines Fahrzeuges erfaBt werden kann, 
Fig. 2 in schematischer Darstellung ein Fahrzeug mit 
io Sensoren, 

Fig. 3 in schematischer Darstellung die Anordnung 
der Rader des Fahrzeuges gemaB Fig. 2, 

Fig. 4 bis 7 einzelne Verfahren zur Bestimmung und 
zur ICorrektur von Fehlern der Fahrzeugposition und/ 
15 oder -orientierung. 

Beim Betrieb von Fahrzeugen, insbesondere von au- 
tomatisch, d. h. ohne Fahrer, arbeitenden Fahrzeugen, 
ist die kontinuierliche Kenntnis der Position und Orien- 
tierung des Fahrzeuges unerlaBIich. In der im folgenden 
20 im einzelnen beschriebenen Steuerung wird die Fahr- 
zeugposition und -orientierung durch eine Komponente 
bestimmt, die fahrzeuginterne BewegungsgroBen zur 
Berechnung heranzieht. Diese BewegungsgroBen sind 
translatorische und rotatorische Geschwindigkeiten in 
25 einer Ebene, die von Sensoren am Fahrzeug erfaBt oder 
bestimmt werden konnen. Vorteilhafterweise werden 
die Geschwindigkeiten bei odometrischer MeBwerter- 
fassung, um Traktionseinfliisse zu umgehen, nicht an 
angetriebenen, sondern an mitlaufenden Radern erfaBt. 
30 Die Moglichkeiten zur sensorischen Erfassung der 
translatorischen und rotatorischen Geschwindigkeit des 
Fahrzeuges reichen von inkrementellen Gebern und Ta- 
chogeneratoren, vorzugsweise an den nicht angetriebe- 
nen Radern, fiber Korrelationssensoren und unter- 
35 schiedlichsten Gebern zur Lenkwinkelmessung bis zum 
Einsatz inertialer Sensoren, vorteilhafterweise Drehra- 
ten-Sensoren oder integrierende Drehraten-Sensoren. 
Aus der fortlaufenden Kenntnis dieser fahrzeugeigenen 
BewegungsgroBen und der bekannten Ausgangsposi- 
40 tion und -orientierung des Fahrzeuges wird unter Be- 
rucksichtigung der evtl. vorhandenen kinematischen 
Kopplung dieser GroBen die Position des Fahrzeuges in 
den drei Freiheitsgraden der Ebene berechnet. Diese 
drei Freiheitsgrade werden durch die X-Y-Koordinaten 
45 und die Orientierung des Fahrzeuges im Raum be- 
stimmt. Die Anzahl der benotigten Sensoren zur Be- 
stimmung der Position in der Ebene hangt von der Fahr- 
zeugkinematik ab. Fur zwangsgef iihrte Fahrzeuge, Leit- 
spurfahr- oder Schienenfahrzeuge, reicht bei bekann- 
50 tern Verlauf der Fuhrung die Kenntnis der Lange des 
zuruckgelegten Wegs zur Bestimmung der Position in 
alien drei Freiheitsgraden aus. In diesem Falle ist die 
Bestimmung der Lage des Fahrzeuges im Raum am ein- 
fachsten durchzufUhren. 
55 Bei zweiachsigen Fahrzeugen mit zwei zwangsgekop- 
pelten Achsen reicht die Erfassung zweier Bewegungs- 
groBen, z. B. einer translatorischen und der rotatori- 
schen Geschwindigkeit oder zweier translatorischer 
Geschwindigkeitskomponenten zur vollst&ndigen Posi- 
60 tionsbestimmung des Fahrzeuges aus. Sind die Achsen 
bzw. Rader des Fahrzeuges jedoch nicht zwangsgekop- 
pelt, dann ist zur Positionsbestimmung des Fahrzeuges 
in der Ebene die Erfassung aller drei unabhSngigen Be- 
wegungsgroBen erforderlich. 
65 Fur die Lageerfassung des Fahrzeuges wird ein Lage- 
erfassungsmodul 1 eingesetzt (Fig. 1), das aus zwei 
Hauptteilkomponenten besteht. Die eine Hauptteil- 
komponente ist ein Lagekoppelungselement 2 und die 
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andere Hauptteilkomponente ein. Lagestiitzungsele- 
ment 3. -Mit dem; Lagekoppelungselement wird dieaktu- 
elle Lage des ?Fahrzeuges< in der ^Ebene ^kontinuierlich 
bestimmt. Mit dem Lagestutzungselement 3 wird die 
Lage des ;FahrzeugeS:T.elativi zu Stutzpunkten im Raum 
gemessen. deren -Position zum Zeitpunkt der Messung 
bekannt : ist. Aus ;ctteser*Messung . ergibt 'Sich, ob die mit 
dem Lagekoppelungselement %ermittelte Position und 
Orientierung des Fahrzeuges mit der tatsachlichen Posi- 
tion und LOrientierung. ubereinstimmt. Gegebenenfalls 
muB eine Korrekturrbeiider weiteren Bewegung des 
Fahrzeuges yorgenommen werden. Dem Lagekoppe- 
lungselement 2Sist eine,, Schnittstelle 4 des Lageerfas- 
sungsmoduls 1 zugeordnet; uber die- Signal e von einer 
am Fahrzeug vorgesehenen Lageerfassungssensorik zu- 
gefuhrt-werden^E)iese^hageerfassungssensorik besteht 
aus einer sinnvolleniAuswahl aus den zuvor erwahnten 
moglichen :Sensoren :i An - einer weiteren Schnittstelle 5 
werden yom Lagestutzungselement 3 Signale und MeB- 
werte ubertragen, die . sich aufgrund einer Lagestiit- 
zungsmessung an den. Stutzpunkten ergeben. An der 
Schnittstelle 6- liefert dasXagekoppelungselement 2 Ist- 
Wert^Signale;,^welche^^die i augenblickiiche Lage des 
Fahrzeuges^ kennzeichnen. Diese Ist-Wert-Signale 7 
werden einem Speicher 8 oder einer Schnittstelle zuge- 
fiihrt Uber eine Schnittstelle 9 des Lageerfassungsmo- 
duls 1 kann z. B.:ein Regler der Fahrzeugsteuerung die 
Ist- Werte der Fahrzeuglage (Position und Orientierung) 
entnehmen und ? mit den; Sollwerten der gewiinschten 
Fahrzeuglage vergleichen, um mit einem Regelsignal 
die Fahrzeugantriebe so zu steuern,daB die gewunschte 
Fahrzeugbahn eingehalten werden kann. 

DasiLageerfassungsmodul 1 hat schlieBlich eine dem 
Lagekoppelungselement 2 zugeordnete Schnittstelle 10, 
uber die-zrB^ vonfoiderizu^emer ubergeordneten (nicht 
dargestellten)>?Ablaufsteuerung Kommandos und Sta- 
tusmeldungen iibertragen werden. 

Dem&tLagestutzungselement 3 ist ebenfalls eine 
Schnittstelle vl 2 des Lageerfassungsmoduls 1 zugeord- 
net, iiber die Kommandos und Statusmeldungen z. B. zu 
und von der Ablaufsteuerung iibertragen werden. Uber 
eine weitere Schnittstelle 13 erhalt das Lagestutzungs- 
element 3 Signale vom Speicher 8. Uber die Schnittstelle 
14 werden die aufgrund der Stutzmessung an den raum- 
festen Stutzpunkten sich ergebenden MeBsignale der 
Schnittstelle. 5 des Lagekoppelungselementes 2 zuge- 
fuhrt. Bei dieser^ Stiitzmessung^ kann sich ergeben, daB 
die Fahrzeugposition und -orientierung nicht mit der 
vom Lagekoppelungselement 2 ermittelten Lage iiber- 
einstimmt. Diese Differenz zwischen den beiden Signa- 
len fuhrt nun dazu, daB das Lagekoppelungselement 2 
die vom Lagestutzungselement 3 gelieferten Signale 
ubernimmt und nach interner Verarbeitung die aktuali- 
sierte Lage iiber die Schnittstelle 6 dem Speicher 8 zu* 
fiihrt. Damit^ubernimmt^ das Lagekoppelungselement 
die aufgrund der Sttitzmessung festgestellte aktuelle La- 
ge des Fahrzeuges. Nunmehr kann mit den im Speicher 
8 abgelegten korrigierten Werten die noch zu beschrei- 
bende Regelung des Fahrzeuges vorgenommen werden. 

Das Lageerfassungsmodul 1 hat schlieBlich eine dem 
Lagestutzungselement* 3 zugeordnete Schnittstelle 15, 
uber die Signale mit der Umgebungssensorik bei der 
Stutzmessung ausgetauscht werden konnen. 

Wie Fig. 3 zeigt, istdas Fahrzeug 16 im Ausfiihrungs- 
beispiel als Dreifadfahrzeug ausgebildet Es hat ein vor- 
deres gelenktes und angetriebenes Rad 17, ein mit Ab- 
stand dahinter liegendes geschlepptes Hinterrad 18, das 
in Form einer Bockrolle ausgebildet ist, sowie an den 
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Fahrzeugecken insgesamt vier frei drehbare Schwenk- 
rollen 19 e bis 22. Zur Lagekoppelung, d.*h. zur Bestim- 
mung den Lage des Fahrzeuges: 16 imder Ebene, is t am 
geschlepptemHinterrad 18ein (nicht dargestelltes) Odo- 
5 meter (Inkrementgeber) vorgesehen, das den zuruckge- 
legten ,Weg des -Fahrzeuges 16 ermittelt- und xntspre- 
chende Signale iiber die Schnittstelle 4 dem Lagekoppe- 
lungselement >2, zufiihrt. Um die Fahrzeugorientierung 
zu ermitteln, ist fahrzeugseitig ein (nicht dargestellter) 

io WendekreiseL vorgesehen, dec die.Fahrzeugdrehrate 
feststelltmnd entsprechende Signale iiber die Schnitt- 
stelle 4 dem 'Lagekoppelungselement 2;zufCihm. Aus den 
Signaleri des Odometers und des Wendekreiselsikann 
somit ?die Ist- Lage des/Fahrzeuges 1 6 im Lagekoppe- 

15 lungselement 2 ermittelt werden. Das entsprechende 
*Ist-Wert-:Signal7 wird uber die Schnittstelle 6 dem Spei- 
cher 8 zugefiihrt. .-;nr,«r^ 

Wahrend^der, Fahrt von einern Ausgangspunkt zu ei- 
nem vorgegebenen Zielpunkt werden an bestimmten 

20 Positionen wahrerid des Fahrwegesidie schon erwahn- 
ten Stutzmessungen durchgefuhrt. Dabei wirdvfestge- 
stellt, ob die vom Lagekoppelungselement 2 ermittelte 
Ist- Position und- Ist-Orientierung^mit der tatsachlichen 
Lage iibereinstimmt Fur diese Stutzmessung werden in 

25 noch zu beschreibender WeiseReferenzpunkte~heran- 
gegezogen, deren Lage im Raum genau bekannt ist. Bei 
diesen 'Stiitzmessungen laBt sich somit sehr >einfach 
iiberprufen, ob> die vom Lagekoppelungselement 2 er- 
mittelte 1st- Position und Ist-Orientierung ; minder tat- 

30 sachlichemLage iibereinstimmt Fur diese Stutzmessung 
ist das Fahrzeug 16 mit wenigstens einem Sensor 23 
(Fig. 2).versehen, der im Ausfuhrungsbeispiel ein Ultra- 
schall-Sensor ist Das Fahrzeug 16 kann auch zwei sol- 
cher Sensoren 23 aufweisen. Da die raumfesten Stutz- 

35 punkte in Fahrtrichtung F des Fahrzeuges sowohl 
rechts als auch links vom Fahrweg liegen konnen, 1 sind 
solche Sensoren 23 an der rechten und an der linken 
Fahrzeuglangsseite vorgesehen. Die Sensoren 23 kon- 
nen auch Irifrarotsensoren sein. Da lnfrarotsensoren ei- 

40 nen sehr scharf gebundelten MeBstrahl erzeugen, wer- 
den sie dort eingesetzt, wo nur sehr kleine MeBflachen 
zur Verfugung stehen. Fiir groBere MeBflachen reicht 
die Verwendung von Ultraschallsensoren 23 aus, die ei- 
nen breiteren MeBstrahl erzeugen. Die MeBsignale der 

45 Sensoren 23 werden iiber die Schnittstelle 15 dem Lage- 
stutzungselement 3 zugefuhrt, das aufgrund^dieser Si- 
gnale die -^Abweichung der vom- Lagekoppelungsele- 
ment 2 bestimmten Lage von der tatsachlichen Lage des 
Fahrzeuges 16 ermittelt und iiber die Schnittstelle 14 

so der Schnittstelle 5 des Lagekoppelungselementes 2 zu- 
fiihrt 

Die Stutzmessung ist erforderlich, weil die Berech- 
nung der Ist-Lage durch das Lagekoppelungselement 2 
fehlerhaft ist, die dazu fuhrt, daB die berechnete lst-La- 

55 ge nicht mehr mit der tatsachlichen Ist-Lage des Fahr- 
zeuges iibereinstimmt Solche Abweichungen, die mit 
zunehmendem Fahrweg groBer werden, sind u. a. auf 
MeBungenauigkeiten der Sensoren zuruckzufuhren. 
Mit der Stutzmessung kann an vorgegebenen Stellen 

60 wahrend des Fahrweges die Lage des Fahrzeuges 16 
sehr einfach festgestellt werden. Beim weiteren Fahren 
wird dann eine entsprechende ICorrektur uber den Reg- 
ler vorgenommen, der den Antrieb des Fahrzeuges 16 
so regelt, daB es wieder auf den Soll-Fahrweg zuriickge- 

65 fiihrt wird. 

Mit dem Lagekoppelungselement 2 wird die jeweilige 
Lage des Fahrzeuges 16 bestimmt Anstelle des am ge- 
schleppten Hinterrad 18 vorgesehenen Wegmessers 
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(Odometer) kann auch am Fahrzeug ein MeBrad vorge- 
sehen sein, mit dem sich ebenfalls der Fahrweg des 
Fahrzeuges 16 ermitteln laBt. Anstelle des Wendekrei : 
sels kann auch beispielsweise ein Lenkwinkelpotentio- 
meter fur das gelenkte Vorderrad 17 vorgesehen sein. 
Auch mit ihm laBt sich eine Richtungsanderung des 
Fahrzeuges 16 exakt erfassen. 

Die MeBwerte aller fur die Lagekoppelung einsetzba- 
ren Sensoren werden fur die Berechnung der Ist-Lage 
des Fahrzeuges 16 zunachst aufbereitet. Dies erfolgt 
mittels eines im Lagekoppelungselement 2 vorhande- 
nen Fehlermodells der Sensoren, mit dem beispielsweise 
die Rohdaten skaliert, gegebenfalls linearisiert und Urn- 
welteinfliisse berlicksichtigt werden, wie z. B. die Tern- 
peratur, der Luftdruck, die Hone iiber dem Meeresspie- 
gel und dgl. Die auf diese Weise vorverarbeiteten Sens- 
ordaten werden anschlieBend zeitdiskret intregriert und 
somit Anderungen der Fahrzeuglage berechnet. Die Be- 
rechnungsmethoden richten sich nach dem zugrundelie- 
genden kinematischen Fahrzeugmodell. Die momenta- 
ne Fahrzeuglage ergibt sich als Summe alier berechne- 
ten Positionsanderungen und der Anfangsbedingungen, 
d, h. der Position und Orientierung des Fahrzeuges im 
Raum am Startpunkt. 

Aus dieser Fahrzeuglage wird anschlieBend die Posi- 
tion der fur die Steuerung relevanten Fahrzeugbezugs- 
punkte berechnet, in das von der Steuerung vorgegebe- 
ne Koordinatensystem transformiert und zusammen mit 
den zugehorigen Gutewerten (mogliche kumulierte 
Fehler der drei Komponenten der Fahrzeuglage) zur 
weiteren Verarbeitung bereitgestellt. 

Zur Vereinfachung der Einbindung der Komponente 
in eine vorhandene Steuerung konnen Initialisierungs- 
daten 11, wie die Daten der Ausgangslage des Fahrzeu- 
ges 16 als Anfangswerte fur die weitere Integration, an 
die Lagekoppelungskomponente 2 uber die Schnittstel- 
le 10 ubergeben werden. Abhangig von der Giite der 
verwendeten Sensoren und den Einsatzbedingungen 
des Fahrzeuges 16 ist die berechnete Fahrzeuglage in 
der beschriebenen Weise mit kumulierenden Fehlern 
behaftet. Infolge dieser [Cumulation nimmt die Fehler- 
groBe mit zuruckgelegtem Fahrweg zu. Zur Kompensa- 
tion dieser Fehler im Lagekoppelungselement 2 liefert 
die Stutzmessung an vorgegebenen Stiitzpunkten Diffe- 
renzen zwischen der mitgekoppelten und der sensorisch 
gemessenen Lage sowie evtL benotigte Steuersequen- 
zen, die eine Aktualisierung durch das Lagekoppelungs- 
element 2 der im Fehlermodell abgelegten Parameter 
erlauben. Dies ftihrt beispielsweise dazu, daB aufgrund 
der Signale des Lagestutzungselementes 3, die von den 
Ist-Wert-Signalen 7 abweichen, das Lagekoppelungs- 
element 2 nunmehr ein entsprechend korrigiertes Signal 
an den Speicher 8 liefert. Dieses korrigierte Signal wird 
vom Lagekoppelungselement 2 fiir die weitergehende 
Integration ubernommen. 

Das im Lagekoppelungselement 2 vorhandene Feh- 
lermodell stellt diejenigen Parameter zur Verfugung, 
welche das Lagekoppelungselement zur Berechnung 
der physikalischen GrSBen aus den an der Schnittstelle 
4 ubergebenen Sensorsignalen benotigt. So liefern Sen- 
soren beispielsweise Signale in Form einer Spannung, 
die beispielsweise in eine Drehrate des Fahrzeuges um- 
gewandelt werden miissen. Die hierzu benotigten Para- 
meter sind im Lagekoppelungselement 2 in Form des 
Fehlermodelles gespeichert. Diese Technologiedaten 
sind sensorabhangig und werden je nach benutztem 
MeBgeber gewahlt. Diese verschiedenen Parameter 
konnen im Fehlermodell des Lagekoppehingselementes 



2 gespeichert sein, konnen aber im Bedarfsfalle auch bei 
Anderung des jeweiligen MeBgebers in das Fehlermo- 
dell des Lagekoppelungselememes 2 eingegeben wer- 
den. 

5 Im kinematischen Modell des Lagekoppelungsele- 
mentes 2 sind weiterhin Parameter gespeichert, welche 
zur Berechnung der Fahrzeugposition aus den senso- 
risch gemessenen BewegungsgroBen benotigt werden. 
Diese Parameter sind fahrwerksabhangig und beruck- 

io sichtigen sowohl das jeweilige Fahrwerkskonzept als 
auch die beim jeweiligen Fahrwerkskonzept vorliegen- 
den geometrischen GroBen. Unter Fahrwerkskonzept 
ist z. B. zu verstehen, ob das Fahrzeug 16 z. B. ein Dreir- 
adfahrwerk, ein Differentialfahrwerk, ein Koordinaten- 

15 fahrwerk oder dgl. besitzt. Je nach diesem Fahrwerks- 
konzept sind unterschiedliche geometrische GroBen des 
Fahrzeuges 16 zu berucksichtigen, anhand derer die 
Fahrzeugposition aus den sensorisch gemessenen Be- 
wegungsgroBen berechnet werden kann. Derartige geo- 

20 metrische GrdBen sind z. B. der Achsabstand des Fahr- 
zeuges 16, der Radstand, die Radbreite und dgl. Diese 
verschiedenen Parameter werden je nach Fahrwerks- 
konzept ausgewahlt und sind notwendig, um zusammen 
mit den sensorisch gemessenen BewegungsgroBen die 

25 Fahrzeuglage zu bestimmen. 

Mit dem Lagestiitzungselement 3 werden zeitlich ku- 
mulierte Fehler, die bei der Messung mittels des Lage- 
koppelungselementes 2 auftreten, kompensiert. Hierzu 
werden Stutzmessungen vorgenommen, bei denen das 

30 Fahrzeug relativ zu zum Zeitpunkt der Messung in ihrer 
Position bekannten Stiitzpunkten vermessen wird. Hier- 
bei wird, ausgehend von der mitgekoppelten Moment- 
anposition, der Ort, an dem zu messen ist, entweder 
bestimmt oder vom ubergeordneten System, z. B. der 

35 Ablaufsteuerung, uber die Schnittstelle 12 ubernommen. 
Das MeBergebnis in Verbindung mit der Kenntnis der 
Stutzpunktlage und der Anbaulage der Sensoren 23 am 
Fahrzeug 16 ermoglicht die Berechnung der Lageab- 
weichung (Positionsablage) des Fahrzeuges von der 

40 durch das Lagekoppelungselement 2 berechneten Fahr- 
zeuglage. Diese Positionsablage wird von der Schnitt- 
stelle 14 (Fig. 1) an die Schnittstelle 5 des Lagekoppe- 
lungselememes 2 ubergeben. Hierbei werden auch 
Steuerkommandos Qbertragen, welche die Art der 

45 Stutzmessung kennzeichnen. 

Die Aktivierung der Stutzmessung kann auf verschie- 
dene Arten erfolgen. Das Lagestiitzungselement 3 kann 
vom Ubergeordneten System, z. B. der Ablaufsteuerung, 
ein Signal zum Start der Messung erhalten. Im Gegen- 

50 satz dazu ist es auch denkbar, daB das Lagestutzungs- 
element 3 die Stutzmessungen aufgrund der (iber die 
Schnittstelle 13 aus dem Speicher 8 zur Verfugung ste- 
henden Informationen iiber die Fahrzeuglage und deren 
Giitewerte in {Combination mit den im Stutzmodell ab- 

55 gelegten Daten der Umgebung vollig selbstandig durch- 
fuhrt. 

Die Haufigkeit der Stutzmessungen ist anwendungs- 
abh&ngig und kann variieren vom vGlligen Verzicht auf 
Stutzmessungen bis zur kontinuierlichen Durchfuhrung 

60 von Stutzmessungen. 

Auch das Lagestiitzungselement 3 beinhaltet ein Feh- 
lermodell, in dem Parameter gespeichert sind, die die 
Umrechung der sensorisch ermittelten MeBdaten in 
physikalische GroBen ermoglichen. AuBerdem sind im 

65 Fehlermodell des LagestUtzungselementes 3 zumindest 
die Daten abgelegt, mit denen die verwendeten Senso- 
ren 23 beschrieben werden. So sind Daten gespeichert 
hinsichtlich der Anbaulage des oder der Sensoren 23 ami 
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Fahrzeug 16, der MeBrichtung, der Parameter fur die 
Ansteuerung, der MeBcharakteristik unddgl. 

Im einfachsten Falbwird eine Stutzmessung dadurch 
ausgelosf, UaB >das^ Uagestutzungselement .3 iibervdie 
Schnittstelle 12 Signaikoirimandos von der ubergeord- 
neten <Ablaufsteuerung erhalt Diese Verfahrensweise . 
setzt aber die Kenhtnis der Lage des Stiitzpunktes und 
des MeBzeitpunktes durch die- Ablaufsteuerung voraus. 
Das andere Extrem ist ein vollig autonom arbeitendes 
Lagestutzungselement 3. In diesem Falle sind die ge- 
samten oder alle c fiir die Stutzmessung relevantenrlnfor- 
mationeh im Stutzmodeli des Lagestutzungselementes 3 
enthalten/Uriter anderem wird die Art des StutzmeB- 
verfahrens und^der Ort, an dem dieses Verfahren ange- 
wendet wird; sowie>die dabei zu benutzenden Sensoren 
automatisch' : vom^Opstatzungselement 3? festgelegti \* 
Ein Beispiel 'einer sinrivollen Variante innerhalb dieser 
Bandbreite^der moglichen Losungen ist die Ubergabe 
einer geometrischeh Beschreibung des Stiitzpunktes. 
und der-'geplanten Bewegungsbahn des Fahrzeuges an 
das Stutzmodeli' des Lagestutzungselementes 3..So kann 
als Referenz am 'Stutzpunkt z. B. eine Kante Oder eine 
Flache herangezogen werden. Dies ist davon abhangig, 
welche Sensoren fin* t die. Stutzmessung herangezogen 
werden, Als Stutzpimkt konnen alle innerhalb des Rau- 
mes, in dem sich das Fahrzeug 16 bewegt, befindlichen 
Einrichturigen herangezogen werden, die fiindiereinge- 
setzte Sensbrik geeignete Merkmale aufweisen, die fur 
die Stutzmessung herangezogen; werden konnen. Befin- 
det sich das Fahrzeug? 16 beispielsweise innerhalb einer 
Lagerhalle mit'Regaleh; Turen, Maschinen und dgL, 
dann kdnnen beispielsweise fur die Stutzmessung^ Fla- 
chen oder Kahten der Maschinen, Tiirkantenoffnungen 
oder die vertikalen Stander der Regale herangezogen 
werden; BeKdieseri Referenzpunkten handelt es sich urn 
ortsfeste Bezugspunkte, deren Lage exakt. festgelegt 
wird und anhand derer mittels des Lagestutzungsele- 
mentes 3* die tatsachliche Lage des Fahrzeuges 16 im 
Raum genaii festgestellt werden kann. 

Im fblgenden wird nun anhand der Fig. 4 bis 7 im 
einzelnen erlautert wie die Abweichungen des Fahrzeu- 
ges 16 mittels der Stutzmessung ermittelt werden 1 kon- 
nen. >: ' J 4 - 

Wahrend der Fahrt des Fahrzeuges 16 wird durch das 
Lagekoppelungselement 2 standig die Fahrzeugposition 
und -orientierung berechnet. Hierbei kommt es aber, 
wie obeh beschrieben, zu unvermeidlichen Fehlern, so 
daB sich das Fahrzeug 16 nach einer bestimmten Fahr- 
strecke trotz kontinuierlicher Berechnung der Fahr- 
zeuglage durch das<Lagekoppelungselement 2 nicht auf 
der Soll-Bahn 24 (Fig. 4) befindet sondern auf einer 
davon' abweichenden Ist-Bahn 25. Wie Fig. 4 beispiel- 
haft zeigt stimmt zwar die Orientierung des Fahrzeuges 
16, nicht jedoch dessen Position. Das Fahrzeug 16 befin- 
det sich lateral translatorisch versetzt zur Soll-Bahn 24. 
Sobald nun das Fahrzeug 16 in Hohe eines Stiitzpunktes 
26 gelangVerfolgteine Stutzmessung. Der Stiitzpunkt 
26 wird im Ausfiihrungsbeispiel nach Fig. 4 durch eine 
Flache gebildet, die beispielsweise die Vorderseite einer 
Maschine, die Vorderseite eines Schrankes oder dgl. 
sein kann. Eritscheidend fiir den Stiitzpunkt 26 ist, daB 
seine Lage im Raum genau bekannt ist Der Stiitzpunkt 
26 stellt somit eirien Bezugspunkt dar, anhand dessen 
die Abweichung Her Lage des Fahrzeuges 16 von der 
durch das Lagekoppelungselement 2 berechneten Bahn; 
die in -erster Naherung mit der Sollbahn 24 ubereins- 
timmt, berechnet werden kann. Sobald das Fahrzeug 16 
seitlich neben dem StUtzpunkt 26 sich befindet, wird die 



• Stutzmessung durchgefuhrt.,Hierbei ; kann i das.Fahrzeug 
..16 in der beschriebenen Weise ein >entsprechendes Si- 
~ rgnalkommando rvon der Ablauf steuerung-erhalten, das 
. uiber die ,Schnittstelle; 12 dem* Lagestutzungselement 3 
5 zugefuhrt wird;. Arbeitet das Lagestutzungselement 3 
■» '■ vollautomatisch, dann>wird.zum erste"n;Mal danngemes- 
sen, wenn aufgrund der vom Lagekoppelungselement 2 
berechneten^ IstrBahn davon auszugehen _ist v daB das 
MeBsignal des Sensors 23 auf den Stutzpunkt,26 trifft 
io und dortreflektiert wird. ; Die <Messung;erfolgt wahrend 
der Fahrt des Fahrzeuges, 16 in .Fahrtrichtung F. f Da der 
Stiitzpunkt .26 eine. in Fahrtrichtung V fsich^erstreckende 
Flache ist, konnenjnehrere Messungen an diesem Sttitz- 
, punkti26?durchgef0hrt werden.rAufgrund des gemesse- 
15 nen seitlichen Abstandes zwischen demJSenspr 23 und 
damit dem Fahrzeug 16 und dem-Stutzpu laBt sich 
einfachifeststellen, daB sich das Fahrzeug 16 nicht auf 
der SolKBahn 24 r sondern auf der parallel dazu versetz- 
ten Ist-Bahn 25 befindet. Das Lagestutzungselemenu3 
20 erhalt uber die. Schnittstelle 15;(Fig v 4) jentsprechende 
Signale-vom Sensor 23, die zur Berechnung der Lageab- 
weichung des Fahrzeuges 16 herangezogen werden. 
Das Lagestutzungselement 3 gibt dann uber^die Schnitt- 
stelle 14 entsprechende Signale an die Schnittstelle 5,des 
25 Lagekoppelungselementes, 2, vwodurch-, dessen? mitge- 
koppelte, bislangfberechnete MeBwerte durch dieyom 
Lagestutzungselement. 3 kommenden Werte ^korrigiert 
werden. Der Speicher 8 erhalt dann entsprechend;kprri- 
gierte Ist-Wert-Signale 7,. die im (nicht dargestellten) 
30 Fahrzeugregler mit den vorgegebenen SpHwerten ver- 
gleichen werden konnen. Da sie im Falle der Fig. 4, nicht 
ubereinstimmen; fuhrt der (nicht dargestellte), Regler 
das Fahrzeug 16 wieder auf die SohNBahn 24 bei der 
weiteren Fahrt zuriick. Dies ist in -Fig. 4,: durch einen 
35 entsprechenden Verlauf der IstrBahn 25 gekennzeich- 
net Nach der Stutzmessung. erfdlgt somit eine Korrek- 
tur der Position des Fahrzeuges 16 in der^Weise, daB es 
sich wieder auf der Soll-Bahn 24 bewegt c 

Je nach Entfernung des Zielortes, kann dann nach ei- 
40 ner bestimmten Zeit oder einer bestimmtemFahrstrecke 
eine erneute Stutzmessung durchgefiihrt^ werden. Auf 
diese Weise wird die vom Lagekoppelungselement 2 
standig berechnete Positionierung und Orientierung des 
Fahrzeuges/16 uberpruft und gegebenenfalls korrigiert 
45 Fig. 5 zeigt nun den Fall, daB das Fahrzeug; 16 nicht 
nur in der Position; sondern auch ;: in der Orientierung 
von der Soll-Bahn 24 abweicht Die Positionsabwei- 
chung des Fahrzeuges 16 wird wiederum aus einzelnen 
Messungen . mit Hilfe des Stiitzpunktes; 26 in der be- 
50^schriebenen Weise berechnet Der Stiitzpunkt 26 wird 
im Ausfiihrungsbeispiel wiederum durch eine.Flache ge- 
bildet an der wahrend der Fahrt des Fahrzeuges 16 
einzelne Messungen mittels des Sensors v23 durchge- 
fiihrt werden. Die Orientierung des -Fahrzeuges 16 wird 
55 aus der Differenz einer quasi gleichzeitigen Messung 
mit einem zweiten Sensor 23 gewonnen.. Er ist zum er- 
sten Sensor in einem bestimmten Abstand in Fahrzeug- 
langsrichtung vorgesehen und miBt auf die gleiche Refe- 
renzflache. Der Abstand a zwischen diesen beiden Sen- 
60 soren 23, in Fahrzeuglangsrichtung gemessen, bildet die 
MeBbasis. Zusammen mit der MeBgenauigkeit der Sen- 
soren 23 ist dieser Abstand a maBgebend fiir die Quali- 
tat der Winkelmessung. Aus dem Abstand a und dem 
unterschiedlichen Abstand der beiden Sensoren 23 zur 
65 Referenzflache 26 laBt sich in einfacher Weise die Ab- 
weichung der Winkellage des Fahrzeuges 16 zur Soll- 
Bahn 24, also die Orientierungsabweichung des Fahr- 
zeuges, berechnen. Die Schnittstelle 15 (Fig. 1) des La- 
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gestiitzungselementes 3 erhait somit MeBdaten, die die 
beiden Abstande der Sensoren 23 des Fahrzeuges 16 zur 
Referenzflache kennzeichnen. Aus diesen MeBwerten 
berechnet das Lagestiitzungselement 3 die Positionie- 
rungs- und Orientierungsabweichung des Fahrzeuges 
16 und liefert uber die Schnittstelle 14 entsprechende 
Signale an die Schnittstelle 5 des Lagekoppelungsele- 
mentes 2. Die so iibermittelten Werte werden vom La- 
gekoppelungselement 2 Ubernommen und zur Berech- 
nung der neuen Ist-Wert-Signale benutzt, die dem Spei- 
cher 8 zugefiihrt werden. Aufgrund der Abweichung des 
Fahrzeuges 16 sowohl hinsichtlich der Position als auch 
hinsichtlich der Orientierung gibt der Regler das ent- 
sprechende Regelsignal an die Antriebe des Fahrzeuges 
16 weiter. Im Ausfuhrungsbeispiel wird das angetriebe- 
ne Vorderrad 17 so eingeschlagen, daB es auf der mit 
einer ausgezeichneten Linie angedeuteten Ist-Bahn 25 
nach der Stutzmessung allmahlich wieder auf die Soll- 
Bahn 24 zuruckgefiihrt wird. Auch in diesem Falle kon- 
nen je nach Entfernung zum Zielort noch eine oder 
mehrere StQtzmessungen in der beschriebenen Weise 
durchgefuhrt werden. 

In Fig. 6 ist eine zweite Moglichkeit dargestellt, wie 
die Positions- und die Orientierungsabweichung des 
Fahrzeuges 16 anhand von Stiitzmessungen bestimmt 
werden konnen. Die Abweichung des Fahrzeuges wird 
zunachst in gleicher Weise, wie unter Fig. 5 beschrieben, 
am Stutzpunkt 26 ermittelt. Es erfolgt danach in einem 
zeitlichen und damit ortlichen Abstand eine zweite Mes- 
sung auf den Stutzpunkt 26a. Bei dieser zweiten Mes- 
sung kann auf einen zweiten Sensor verzichtet werden. 
In diesem Falle dient der zuruckgelegte Weg zwischen 
zwei Messungen als MeBbasis die dabei wesentlich gro- 
Ber sein kann als der Abstand a zwischen zwei in Fahr- 
zeuglangsrichtung hintereinander angeordneten Sensor 
(Fig. 5). Die Messung der Orientierungsabweichung des 
Fahrzeuges kann darum mit einer hoheren Genauigkeit 
vorgenommen werden. 

Allerdings muB eine ausreichende Richtungsstabilitat 
des Fahrzeuges 16 zwischen den beiden Messungen 
vorausgesetzt werden. 

Das Fahrzeug 16 wird nach der ersten Messung am 
Stutzpunkt 26 langs der mit einer ausgezogenen Linie 
dargestellten Ist-Bahn 25 grob auf die mit einer gestri- 
chelten Linie gekennzeichnete Soll-Bahn 24 zuruckge- 
fiihrt. Nach einem gewissen zeitlichen und somit ortli- 
chen Abstand erfolgt die zweite Messung am zweiten 
Stutzpunkt 26a. Bei der Darstellung gemaB Fig. 6 ist 
angenommen worden, daB das Fahrzeug 16 nach - der 
ersten Korrektur mit Hilfe des Stutzpunktes 26 noch 
nicht vollstandig auf die Soll-Bahn 24 zuruckgefiihrt 
worden ist, sondern hinsichtlich der Orientierung noch 
Abweichungen von der Soll-Bahn aufweist. Diese Ab- 
weichungen sind allerdings aufgrund der ersten Korrek- 
tur wesentlich geringer als zum Zeitpunkt der ersten 
Messung am Stutzpunkt 26. Am zweiten Stutzpunkt 26a 
wird nun mit dem Sensor 23 eine zweite Messung durch- 
gefuhrt. Auf die Verwendung des zweiten Sensors kann 
verzichtet werden, weil als MeBbasis der zwischen der 
ersten und der zweiten Messung zuruckgelegte Weg 
des Fahrzeuges 16 verwendet wird. Die bei der zweiten 
Stutzmessung erhaitenen MeBwerte werden uber die 
Schnittstelle 15 dem Lagestiitzungselement 3 zugefiihrt, 
das hieraus die Lageabweichung des Fahrzeuges 16 be- 
rechnet und uber die Schnittstelle 14 der Schnittstelle 5 
des Lagekoppelungselementes 2 zuf iihrt. Es benutzt die- 
se Werte zur Korrektur der mitgekoppelten Ist- Werte 
und fahrt diese dem Speicher 8 zu. Der Regler gibt 



aufgrund des Soll-Ist-Vergleiches unter Beriicksichti- 
gung des Inhaltes des Speichers 8 ein entsprechendes 
Regelsignal 9 an die Antriebe des Fahrzeuges 16, so daB 
es langs der mit ausgezogener Linie dargestellten 1st- 
5 Bahn 25 wieder auf die Soll-Bahn 24 zuruckgefiihrt wird. 
Ohne die zweite Korrektur wiirde das Fahrzeug 16 
langs der Linie 25a weiterfahren. Aufgrund der zweiten 
Korrektur wird jedoch die Ist-Bahn 25 wieder auf die 
Soll-Bahn 24 zuruckgefiihrt. 

to 1st bei der Verfahrensweise gemaB Fig. 6 die Refe- 
renzflache 26 ausreichend lang, dann reicht auch nur 
diese eine Referenzflache als Stutzpunkt aus, um die 
beiden zeitlich versetzten und damit ortlich mit Abstand 
voneinander liegenden Messungen durchzufiihren. 

15 Es ist bekannt, daB Sensoren ein sogenanntes Drift- 
verhalten haben, d. h. die mathematische Modellierung 
des Sensorverhaltens bei der Umwandlung der physika- 
lischen GroBe in einen digitalen MeBwert ist unvollstan- 
dig, so daB, wenn auch geringfiigige, Abweichungen 

20 zwischen dem verarbeitbaren MeBwert und der da- 
durch quantifizierten physikalischen GroBe entstehen. 
Die Parameter der Ubertragungsfunktion (Zusammen- 
hang zwischen physikalischer GroBe und digitalem 
MeBwert), die im Fehlermodell abgelegt sind, konnen 

25 zeitabhangig sein, so daB sie von Zeit zu Zeit kompen- 
siert werden konnen. 

Bei der Bestimmung der Position und der Orientie- 
rung des Fahrzeuges 16 konnen auch viele schnell auf- 
einanderfolgende Messungen mit dem oder den Senso- 

30 ren 23, 32 auf die jeweilige Referenzflache 26 durchge- 
fiihrt werden. Hierbei entsteht eine MeBdatenreihe, die 
zur Auswertung linearisiert wird. Die L&nge dieser 
MeBreihe (MeBbasis) ist zusammen mit der MeBgenau- 
igkeit des Sensors 23, 32 fur die Qualitat der Messung 

35 der Winkelabweichung und damit fur die Bestimmung 
der Orientierungsabweichung des Fahrzeuges 16 ent- 
scheidend. 

Zusatzlich zu der zuvor beschriebenen Bestimmung 
der Position und Orientierung mittels vieler, schnell auf- 

40 einanderfolgender Messungen des Sensors kann eine 
dritte Koordinate der Fahrzeugposition dadurch ermit- 
telt werden, daB die Messungen vor Beginn der Refe- 
renzflache starten (Fig. 7). Das Fahrzeug 16 bewegt sich 
in X-Richtung. Der Sensor 32 sendet, noch bevor der 

45 Stutzpunkt 26b erreicht ist, MeBsignale aus, die aber 
wegen Fehlens des Stutzpunktes 26b nicht reflektiert 
werden. Im X-Y-Koordinatensystem ergibt sich da- 
durch der Kurvenabschnitt 27. Er verlauft parallel zur 
X-Koordinate und hat die Steigung O. Der Stutzpunkt 

50 26b ist schrkg zur Fahrtrichtung X angeordnet. Als Be- 
zugspunkt dient — im Gegensatz zu den vorigen Aus- 
fiihrungsbeispielen — nicht nur eine Flache, sondern 
zusatzlich eine Kante 28 des Stutzpunktes. Sobald der 
vom Sensor 32 in X-Richtung ausgesandte MeBstrahl 

55 die Bezugskante 28 erfaBt, wird ein auswertbares Signal 
detektiert Im X-Y-Koordinatensystem ergibt sich der 
Kurvenabschnitt 29, der gegeniiber dem Kurvenab- 
schnitt 27 verhaitnismaBig steil abfallt. Kurz nach MeB- 
beginn ergibt sich dann der Kurvenabschnitt 30, dessen 

60 Steigung der Neigung c der dem Fahrzeug 16 zuge- 
wandten Stirnseite 31 des Stutzpunktes 26b in bezug auf 
die Fahrtrichtung x entspricht. 

In Y-Richtung wird der Abstand des Sensors 32 und 
damit des Fahrzeuges 16 vom Stutzpunkt 26b ermittelt. 

65 Zur Bestimmung der Lageabweichung in X-Richtung 
wird die aktuelle Fahrzeuglage sowie der Obergang 
zwischen den Kurvenabschnitten 29 und 30 benutzt. 
Damit das Fahrzeug 16 unterschiedliche Routen fah- 
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ren kann, beispielsweise mit Hilfe einer CAD-Umge- 
bung ein GrundriB.des Einsatzgebietes des Fahrzeuges 
erzeugt oder verandert werden ~kann7 Hierin* sind die 
virtuellen Fahrwege, Lastubergabestationen und die 
Stutzpunkte 26, 26a, 26b zur Lagebestimmung gespei- 5 
chert. Im Fahrzeugleitsystem konnen automatisch Fahr- 
programme fur das Fahrzeug 16 erzeugt werden. Diese 
Daten werden uber eine Infrarot-Datenubertragungs- 
strecke vom Fahrzeugleitsystem zum Fahrzeug 16 tiber- 
tragen. Ober diese Infrarot-Dateniibertragungsstrecke 10 
konnen auch Auftrage an das Fahrzeug 16 gerichtet und 
Statusmeldungen vom Fahrzeug empfangen werden. 
Auf dem Fahrzeug 16 werden die Fahrprogramme ver- 
waltet. Sie konnen gespeichert, geloscht und ausgefiihrt 
werden. 15 

Es ist aber auch mdglich, das Fahrzeug 16 ohne einen 
Leitrechner zu betreiben. In diesem Falle kann das 
Fahrprogramm fest in einem statischen Speicher des 
Fahrzeuges 16 abgelegt sein. Die Fahrprogramme kon- 
nen aber auch aus dem auf dem Fahrzeug abgelegten 20 
Modell der Umgebung erzeugt werden. 

Das Fahrzeug benotigt keine Leitlinie, sondern kann 
anhand des eingegebenen Fahrprogrammes selbsttatig 
an den gewunschten Einsatzort fahren. Wahrend der 
Fahrt erfolgen die beschriebenen Messungen, um si- 25 
cherzustellen, daB das Fahrzeug 16 vom Ausgangsort 
zum Zielort gelangt. 

Werden bei der Bestimmung der Position und der 
Orientierung an den Stiitzpunkten Flachen als Bezugs- 
punkte verwendet, konnen als Sensoren 23 Ultraschall- 30 
sensoren eingesetzt werden, deren MeBstrahl eine ge- 
wisse Breite hat. Werden jedoch, wie beispielhaft an- 
hand von Fig. 7 erlautert worden ist, Kanten am Stiitz- 
punkt als Bezugspunkt herangezogen, dann sind Ultra- 
schallsensoren zur Abstandsmessung nicht zweckmaBig. 35 
In diesem Fall werden vorteilhaft solche Sensoren ein- 
gesetzt, die einen sehr scharf gebundelten MeBstrahl 
erzeugen, wie beispielsweise Infrarotsensoren. Solche 
Kanten konnten beispielsweise auch an Durchbruchen, 
Fenstern und dgl. an Maschinengehausen, Turen, 40 
Schranken oder dgl. als Bezugspunkte herangezogen 
werden. 

Die Sensoren 32 konnen auch zum Andocken des 
Fahrzeuges 16 beispielsweise an einen Lagerplatz, an 
eine Obergabestelle oder dgl. benutzt werden. Dabei 45 
fiihrt der Sensor 32 das Fahrzeug 16 durch entsprechen- 
de Messung exakt an die gewunschte Stelle heran. Vor- 
zugsweise sind solche Sensoren 32 Infrarotsensoren, da 
das Andocken eine sehr genaue Messung erfordert. 

Daruber hinaus kann das Fahrzeug 16 mit Uberwa- 50 
chungssensoren 33 ausgestattet sein, die bei der Fahrt 
des Fahrzeuges iiberwachen, ob sich im Fahrweg Hin- 
dernisse befinden. Beispielsweise sind diese Uberwa- 
chungssensoren durch Ultraschallsensoren gebildet. 

Fur die beschriebenen Stiitzmessungen konnen auch 55 
alternative Sensoren, z. B. Magnetmarken, optische 
oder induktive Marken oder Linien, eingesetzt werden. 
Die Prinzipien der Stiitzmessungen bleiben hierbei aber 
unverandert. Lediglich die entsprechenden Parameter 
miissen an diese alternativen Sensoren angepaBt wer- #) 
den. 

Mit den beschriebenen Einrichtungen besteht zu je- 
dem Zeitpunkt eine genaue Kenntnis uber die Lage des 
Fahrzeuges im Raum bzw. in der Ebene. Da die Lage 
des Ausgangspunktes des Fahrzeuges in der Ebene be- 65 
kannt ist, ist durch die wahrend der Fahrt des Fahrzeu- 
ges 16 standig berechneten Positionierungs- und Orien- 
tierungswerte sichergestellt, daB die Lage und Orientie- 
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rung des Fahrzeuges in der Ebene jederzeit bekannt ist. 

Die beschriebenen Einrichtungen sind fiir fahrerlose 
Transportsysteme, fur -Reinigungsroboter,>f iir Service- 
roboter oder fiir andere mobile Roboter geeigjnet, wie 
z. B. fiir Asphaltsagen.'Erkundungs- und/oder Llberwa- 
chungsfahrzeuge und dgl. Auch Gabelstapler und Mani- 
pulatoren konnen mit einem solchen Lageerfassungs- 
modul 1 ausgerustet werden. Dariiber hinaus konnen 
auch andere bemannte Fahrzeuge zur Unterstutzung 
des Fahrers oder zur Information des. .Leitsystems mit 
diesem Lageerfassungsmodul 1 ausgestattetwerden. 

Patentanspriiche 

1. Verfahren zur Ist-Lage-Erfassung von landge- 
bundehen Fahrzeugen, insbesondere'von'mobilen 
autonomen Robotern, von Gabelstaplern und dgU 
bei dem die Ist- Lage des Fahrzeuges wahrend der 
Fahrt durch koppelnde Verfahren erfaBt wird;«da- 
durch gekennzeichnet, daB wenigstens eine Stutz- 
messung durchgefuhrt wird, bei der die Abwei- 
chung der durch koppelnde Verfahren bestimmten 
Ist-Lage des Fahrzeuges (16) anhand raumfester, in 
ihrer Lage bekannter Stutzpunkte (26; 26a, 26b) 
ermittelt wird, daB aufgrurid dieser^Abweichungeh 
die Ist-Lage korrigiert wird, und daB diesen korri- 
gierte Wert zur weiteren Verarbeitung-zur Verfii- 
gung gestellt wird. 

2. Verfahren ri'ach Anspruch 1, dadurch gekenn- 
zeichnet, daB der korrigierte Wert zur Steuerung 
oder Regelung des Fahrzeuges (16) herangezogen 
wird 

3. Verfahren nach Anspruch 1, dadurch gekenn- 
zeichnet, daB der korrigierte Wert zur Information, 
beispielsweise zur Anzeige in einem Display, be- 
nutzt wird. 

4. Verfahren nach einem der Anspriiche 1 bis 3, 
dadurch gekennzeichnet, daB die Lageabweichung 
des Fahrzeuges (16) aus einzelnen Messungen auf 
eine Referenzflache des StQtzpunktes (26 t 26a, 26b) 
bestimmt wird. 

5. Verfahren nach einem der Anspriiche 1 bis 4, 
dadurch gekennzeichnet, daB zur Bestimmung der 
Orientierungsabweichung " (Winkellageabwei- 
chung) des Fahrzeuges (16) an mit Abstand voriein- 
ander liegenden Stellen der Referenzflache des 
StOtzpuriktes (26, 26a, 26b)"zwei Abstandsmessun- 
gen durchgefuhrt werden. 

6. Verfahren nach Anspruch 5, dadurch gekenn- 
zeichnet, daB gleichzeitig zwei Abstandsmessungen 
zu derselben Referenzflache des Stiitzpuriktes (26, 
26a, 26b) durchgefuhrt werden, wobei als MeBbasis 
(a) der Abstand zwischen zwei in Langsrichtung des 
Fahrzeuges (16) vorgesehenen MeBelementen (23) 
herangezogen wird. 

7. Verfahren nach Anspruch 5, dadurch gekenn- 
zeichnet, daB zwei Abstandmessungen in einem 
zeitlichen und damit ortlichen Abstand durchge- 
fuhrt werden, wobei als MeBbasis der zwischen den 
beiden Messungen zuruckgelegte Weg des Fahr- 
zeuges (16) herangezogen wird. 

8. Verfahren nach Anspruch 7, dadurch gekenn- 
zeichnet, daB nach jeder Abstandsmessung die 
durch die koppelnden Verfahren bestimmte Ist-La- 
ge des Fahrzeuges (16) entsprechend korrigiert 
wird. 

9. Verfahren nach einem der Anspriiche 1 bis 8, 
dadurch gekennzeichnet, daB viele, schnell aufein- 
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anderfolgende Messungen auf eine Referenzflache 
des Stutzpunktes (26, 26a, 26b) durchgefuhrt wer- 
den, und daB die aufgenommene MeBdatenreihe 
linearisiert wird. 

10. Lageerfassungssystem zur Durchfuhrung des 5 
Verfahrens nach einem der Anspruche 1 bis 9, mit 
mindestens einem Lagekoppelungselement zur 
koppelnden Bestimmung der Fahrzeuglage und mit 
mindestens einem Lagestutzungselement, mit dem 
die Lage des Fahrzeuges relativ zur Umgebung 10 
vermessen wird, dadurch gekennzeichnet, daB das 
Lagekoppelungselement (2) und das Lagestut- 
zungselement (3) in einem Lageerfassungsmodul 
(1) zugesammengefaBt sind, das wenigstens eine 
Schnittstelle (9) fur die Ausgabe des korrigierten 15 
Wertes, mindestens eine zweite Schnittstelle (10) 
fur Initialisierungsdaten, mindestens eine dritte 
Schnittstelle (4) fur die Lageerfassungssensorik und 
mindestens eine vierte Schnittstelle (15) fur die Um- 
gebungssensorik (23, 32) aufweist. 20 

11. Lageerfassungssystem nach Anspruch 10, da- 
durch gekennzeichnet, daB das Lageerfassungsmo- 
dul (1) an eine ubergeordnete Ablaufsteuerung an- 
geschlossen ist. 

12. Lageerfassungssystem nach Anspruch 10, da- 25 
durch gekennzeichnet, daB das Lageerfassungsmo- 
dul (1) an ein Display, einen Datenubertrager zu 
einem Leitrechner und dgl. angeschlossen ist. 

13. Lageerfassungssystem nach einem der Anspru- 
che 10 bis 12, dadurch gekennzeichnet, daB das La- 30 
gestutzungselement (3) dem Lagekoppelungsele- 
ment (2) iibergeordnet ist. 

14. Lageerfassungssystem nach einem der Anspru- 
che 10 bis 13, dadurch gekennzeichnet, daB die La- 
geerfassungssensorik mindestens ein Odometer 35 
aufweist. 

15. Lageerfassungssystem nach einem der Anspru- 
che 10 bis 13, dadurch gekennzeichnet, daB die La- 
geerfassungssensorik mindestens einen Wende- 
kreisel oder mindestens einen integrierenden Wen- 40 
dekreisel aufweist. 

16. Lageerfassungssystem nach einem der Anspru- 
che 10 bis 15, dadurch gekennzeichnet, daB die Urn- 
gebungssensorik mindestens einen Ultraschallsen- 
sor (23) aufweist. 45 

17. Lageerfassungssystem nach einem der Anspru- 
che 10 bis 1 5, dadurch gekennzeichnet, daB die Um- 
gebungssensorik mindestens einen Infrarotsensor 
(32) aufweist. 

18. Lageerfassungssystem nach einem der Anspni- 50 
che 10 bis 17, dadurch gekennzeichnet, daB das La- 
gekoppelungselement (2) und das Lagestutzungs- 
element (3) jeweils mindestens ein Fehiermodell ftir 
die eingesetzten Sensoren (23, 32) der Lageerfas- 
sungssensorik bzw. der Umgebungssensorik auf- 55 
weist. 

19. Lageerfassungssystem nach einem der Anspru- 
che 10 bis 18, dadurch gekennzeichnet, daB das La- 
gekoppelungselement (2) mindestens ein kinemati- 
sches Modell enthalt, in dem die Art der Fahrzeug- 60 
kinematik und deren Eigenschaften beschrieben 
sind. 

20. Lageerfassungssystem nach einem der Anspru- 
che 10 bis 19, dadurch gekennzeichnet, daB das La- 
gestutzungselement (3) mindestens ein Stiitzmodell 65 
enthalt, in dem die Positionen und die Eigenschaf- 
ten der StUtzpunkte (26, 26a, 26b) beschrieben sind. 
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